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Description 

TECHNICAL FIELD 

5 [0001] The present invention relates to a method for calibration of an industrial robot, which has a plurality of move- 
ment axes with a position transducer for each one of the axes adapted to deliver an output signal which defines the cur- 
rent position of the axis, and a robot hand for supporting a tool. 

[0002] The invention also relates to an industrial robot system with an industrial robot which has a plurality of move- 
ment axes with a position transducer for each of these axes which is adapted to deliver an output signal which defines 
10 the current position of the axis, a robot hand for supporting a tool, and a control system for control of the position and 
orientation of the robot hand in accordance with a program and adapted to receive the output signals of the position 
transducers. 

BACKGROUND ART 

15 

[0003] An industrial robot may be viewed as a chain consisting of stiff links. Two links are joined to each other in such 
a way that they are rotatable in relation to each other around an axis of rotation, or displaceable in relation to each other 
along a linear movement path. An industrial robot usually has six axes of rotation. The last link in the chain may consist 
of a tool which, depending on the field of application, may be a gripper, a glue gun or a welding gun. In the following, 

20 the links in a robot will be referred to as arms, and their lengths will be referred to as arm's lengths. 

[0004] For each one of the above-mentioned axes of rotation or linear movement paths, servo equipment with a driv- 
ing motor and a position transducer is provided, the transducer delivering a signal which is a measure of the angle of 
rotation of the actual axis in relation to a reference position. The servo system of each axis is supplied with a reference 
value of the angle of rotation or linear movement of the axis, and the driving motor of the axis causes to robot to move 

25 until the axis position indicated by the position transducer of the axis corresponds to the reference value supplied to the 
servo system. In order for the position and orientation of the tool to correspond to the desired values, the mechanical 
structure of the robot and the parameters, so-called kinematic parameters, which describe it must be known with a high 
accuracy. Since the kinematic parameters are not exactly the same for each robot, the individual deviations from an 
ideal robot, that is, the kinematic error parameters of the robot, must be known if a high accuracy is to be attained. 

30 [0005] Examples of kinematic error parameters are variations in the lengths of the arms, so-called arm's length errors, 
obliquities in the axes of rotation in relation to each other, so-called axis-attitude errors, and lateral displacements of the 
axes in relation to each other, so-called axis-offset errors. These deviations arise during manufacture of the different 
mechanical components and during the assembly thereof. To this is to be added the fact that the angle indicated by the 
position transducer of an axis must with great accuracy correspond to the actual angle of rotation of the arm which is 

35 controlled with the aid of the axis in question, the so-called encoder offset value. To determine the deviation of an indi- 
vidual robot from an ideal robot, various forms of calibration methods are used. 

[0006] From Swedish patent document 9303757, a calibration method is known in which a spherical calibration body 
with a known radius is used. A calibration tool, comprising a sphere with a known radius, mounted on the robot hand is 
brought into contact with the calibration body in a number of different robot configurations. When the calibration tool and 
40 the calibration body are in contact with each other, position transducer signals are read and stored. Thereafter, the cal- 
ibration parameters of the robot are calculated on the basis of the kinematic equations of the robot, a model of the rela- 
tionship between axial position and position transducer signal, the known radius, and the read and stored position 
transducer signals. 

[0007] The disadvantage with this calibration method is that the robot has to make contact with the calibration tool 
45 and that the calibration body has a limited extent. Upon the repeated contact between the robot and the calibration 
body, mechanical stresses may build up in the robot which may, in turn, lead to an unreliable calibration result. The fact 
that the reading is performed upon mechanical contact between the calibration tool and the calibration body leads to 
variations in the reading position; for example, the calibration body may be somewhat resilient upon contact with the 
calibration tool. The limited extent of the calibration body reduces the possibilities of varying the robot configurations, 
so which in turn affects the accuracy in the calibration. 

SUMMARY OF THE INVENTION 

[0008] The object of the invention is to provide a method for calibration of an industrial robot, wherein mechanical con- 
55 tact between the calibration tool and an outer body is not needed, and which provides greater freedom to vary the con- 
figurations of the robot during the calibration, and hence provides improved accuracy. 

[0009] The invention also aims to provide an industrial robot system with means for carrying out the above-mentioned 
method. 
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[0010] What characterizes a method and an industrial robot system according to the invention will be clear from the 
appended claims. 

BRIEF DESCRIPTION OF THE DRAWINGS 

5 

[001 1 ] 

Figure 1 schematically shows an industrial robot with a calibration tool and a calibration device according to the 
invention. 

10 

Figure 2 shows a vertical calibration beam in the base coordinate system of the robot. 

Figures 3a - 3c show examples of various configurations which may be assumed by the robot when carrying out 
the calibration method. 

15 

Figure 4 shows the composition of an industrial robot system with means for carrying out the calibration method. 

Figure 5 shows in the form of a flow diagram an example of a program for automatically carrying out the calibration 
method. 

20 

Figure 6 shows in the form of a flow diagram the principle of carrying out the calculations, by means of which the 
calibration parameters are obtained as a result of the calibration method. 

Figure 7 illustrates the calibration parameters for a robot axis. 

25 

DESCRIPTION OF THE PREFERRED EMBODIMENTS 

[0012] Figure 1 shows an example of a known industrial robot which may advantageously be calibrated with the 
method and the device according to the invention. On a base 1 , the foot 2 of the robot is mounted. The robot has a f irst 

30 arm 3, which is rotatable in relation to the foot 2 around a vertical axis A1 . At the upper end of the first arm, a second 
robot arm 4 is journalled and rotatable in relation to the first arm around a second axis A2. At the outer end of the sec- 
ond arm, a third arm 5 is journalled and rotatable in relation to the second arm around an axis A3. The third robot arm 
5 comprises two parts 5a and 5b, the outer part 5b being rotatable in relation to the inner part 5b around an axis of rota- 
tion A4 coinciding with the longitudinal axis of the arm. At its outer end, the third arm 5 supports a fourth arm 6, which 

35 is rotatable around an axis of rotation A5 perpendicular to the longitudinal axis of the third arm. The outer part of the 
fourth arm consists of a tool attachment 6a which is rotatable in relation to the inner part of the fourth arm around an 
axis of rotation A6. The angles of rotation in the six axes of rotation A1 ... A6 are designated 61. ..66 in the figure. The 
fourth arm and the tool attachment are referred to as the hand of the robot. On the tool attachment, a calibration tool 7 
is mounted. At its outer end, the calibration tool 7 supports a spherical body 7a, the radius r of which is known. The 

40 length and offset l 2 of the calibration tool are known. 

[0013] The control unit 8 of the robot comprises in a known way computer equipment with necessary memories for 
programs and other data, drives for the driving motors of the various robot axes, and necessary supply equipment. The 
control unit is connected to a programming unit 9 for programming and other service of the robot 
[0014] A calibration device 10 is arranged in the working range of the robot and comprises a transmitter 1 1 which 

45 transmits a calibration beam 12 in the form of a laser beam, and an interruption detector 13 which detects and gener- 
ates an output signal in case of interruption of the calibration beam 12. The calibration beam is arranged in parallel with 
the axis of rotation A1 . The calibration device further comprises a stand 14 which supports the transmitter 1 1 and the 
interruption detector 13. A line 15 is arranged for transmission of the output signal from the interruption detector 13 to 
the control unit 8. 

so [001 5] Figure 2 shows the base coordinate system (x,y,z) of the robot, which system is an orthogonal coordinate sys- 
tem with the z-axis coinciding with the axis of rotation A1 and with the x-axis and the y-axis in predetermined directions 
relative to the robot foot 2. The centre of the spherical body 7a has the coordinates (Xs,y s ,z s ). The calibration beam is 
parallel to the z-axis. The coordinates xq and y 0 are the intersection of the calibration beam with the xy plane. These 
two coordinates constitute two unknown parameters and must be added to the number of calibration parameters which 

55 are to be calibrated. 

[001 6] In the calibration method according to the invention, a plurality of measurements are carried out. The number 
of measurements should be at least as large as the number of unknown parameters, that is, the number of calibration 
parameters to be calibrated plus two. The number of measurements may, however, advantageously be larger, prefera- 



3 



r 



* 



EP 0 824 393 B1 

bly considerably larger, whereby increased accuracy of the calibration may be obtained. The calibration method accord- 
ing to the invention also tends to give increased accuracy the greater the difference between the robot configurations 

used. 

[0017] During the calibration, the calibration tool is run towards the beam until the interruption detector detects an 
5 interruption of the beam. Then the difference between the centre of the spherical body 7a and the beam 12 is equal to 
the radius r of the sphere. The equation of the sphere gives the following relationship: 

(x s -x 0 ) 2 +(y s -y 0 ) 2 =r 2 (1) 

10 [0018] During each measurement, the robot is first run - manually or automatically - to a configuration where the cal- 
ibration tool 7 is at a point at some distance away from the calibration beam. The robot is then run such that the calibra- 
tion tool moves in a direction towards the calibration beam until the interruption detector 1 3 detects that the beam has 
been interrupted. The movement is interrupted when an interruption has been detected. When an interruption has been 
obtained, the output signals from the position transducers of the robot are read and stored. 

is [001 9] Measurements are carried out at a plurality of different points on the calibration beam with different configura- 
tions of the robot. The configuration of the robot is defined by its axial angles, and one configuration differs from another 
if at least some of the axial angles has been changed. Figure 3a - 3c show examples of three different robot configura- 
tions during measurement of three different points on the calibration beam 12. 

[0020] The accuracy of the calibration may be increased by calculating the calibration parameters several times with 
20 the calibration beam in varying positions in the working range of the robot. The calibration parameters may, for example, 

be calculated as a mean value of the calibration parameters calculated for the different positions. 

[0021] As position transducers in industrial robots, resolvers are usually used, and the calibration method according 

to the invention will be described in the following as applied to an industrial robot with this type of position transducer. 

However, the invention may be applied to robots with other types of position transducers. The calibration parameters 
25 which need to be identified are for each degree of freedom of the robot: 

The offset coordinate for arm link (OX, OY, OZ) 
The obliquity of the axis of rotation (Y, P) of the arm link 
The angular offset value of the position transducer (K2) of the axis of rotation 
30 - The coordinates for the intersection of the calibration beam with the xy plane (xq, y 0 ) 

[0022] For a 6-axis robot, this gives in total 38 parameters which are to be identified. Altogether, thus, 38 positionings 
in relation to the calibration beam are required. Upon each positioning the position transducer of the robot is read. 
[0023] The kinematic model of the robot, that is, the relationship between the coordinates for the position of the cali- 
35 bration tool, in this example the centre coordinates (x^y^) of the sphere, and the arm angles of the robot may be 
expressed by: 

f x (6) = x s 

40 f y (e) = y s (2) 

f z (e) = z s 

[0024] The arm angle (6) can be expressed in the def lection <3> of the position transducers by 

45 

6 = K1<3> + K2 (3) 

where 

so - K1 is the transmission gear ratio between the arm angle and the position transducer. (K1 is known) 
K2 is an unknown angular offset value. 

[0025] Equations 1 and 2 give: 

55 (f x (e)-x 0 ) 2 + (f y (6)-y 0 ) 2 =r 2 (4) 

[0026] After inserting the expression for arm angle 6 and the read values of the position transducers <3> for the posi- 
tioning in question, the equation can be expressed as follows: 
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5 



g(K21, K22, K23, K24, K25, K26, 
0X1, 0X2, 0X3, 0X4, 0X5, 0X6, 
0Y1, 0Y2, 0Y3, 0Y4, 0Y5, 0Y6, 
0Z1 , 0Z2, 0Z3, OZ4, OZ5, 0Z6, 
Y1 , Y2, Y3, Y4, Y5, Y6, 



P1, P2, P3, P4, P5, P6, XO, YO) = r 2 
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Or written in a more compact way: 



g(K2, OX, OY, OZ, Y, P, QO) = r 2 



[0027] In this way, at least 38 equations are generated. 
15 [0028] The calculation of the unknown calibration parameters from the non-linear equation system may be made 
according to the following: 

[0029] First, preliminary values of the calibration parameters are set. The initial angular offset values K2 may be 
obtained by bringing the robot to an approximate initial position (arm angles = 0), whereupon the resolver angles on 
each axis are read. Also xq, y 0 are estimated. The other calibration parameters are set to zero (nominal robot). For each 
20 measurement j, the distance between the centre of the calibration tool and the centre of the sphere is calculated, start- 
ing from the read resolver values and from the kinematic model of the robot. The difference €j between the value thus 
calculated and the known distance r is formed. When these differences are formed for all positionings, a quantity 



[0030] The quantity e is then compared with a predetermined tolerance value. If e is greater than this value, the set 
values are adjusted according to the Newton-Gauss algorithm for solution of overdeter mined non-linear equation sys- 
tems, and the above-mentioned method is repeated until e falls below the tolerance value. Finally, the calibration param- 

30 eters thus determined are stored to be used for correcting the position of the robot during operation. 

[0031] To make it possible to determine the unknown parameters, the number of measurements must be at least as 
large as the number of parameters to be calibrated. In the case described above, it has been assumed that all the six 
axes of the robot are to be calibrated, and the smallest number of measurements, namely, 2 + 6 • 6 = 38, has been 
assumed. However, it may be suitable to carry out a considerably larger number of measurements with different corrf ig- 

35 urations, which has contributed to give improved accuracy during the calibration 

[0032] Figure 4 shows, in principle, the composition of an industrial robot system with control means for automatically 
carrying out the calibration method described above. The robot 2-6 is provided in the manner described above with a 
calibration tool 7. Of the control unit, Figure 4 shows a program executor 20, which in a known way causes the robot to 
carry out a stored program. In a first memory 21, the kinematic model of the robot is stored. In a second memory 22, 

40 the movement program for the calibration process is stored. In a third memory 23, values of the preliminary calibration 
parameters are stored prior to the automatic calibration process. A fourth memory 24 is intended for storage of the 
resolver values read for each measurement during the calibration process. In a fifth memory 25, there are stored, prior 
to the automatic calibration process, the necessary basic data such as the length l-| and the offset l 2 and the radius r of 
the calibration tool. 

45 [0033] The control equipment further comprises calculating means 26 which, when all the measurements have been 
executed, on the basis of the read resolver values, the kinematic model and basic data from the fifth memory 25, cal- 
culate the calibration parameters in the manner described above. The control equipment delivers the necessary control 
signals CS to the robot and receives from the robot the resolver values TS. Further, the control unit of the robot com- 
prises a member 27 which generates a stop signal to the robot when the output signal from the interruption detector 13 

50 indicates that the calibration beam 1 2 is interrupted. 

[0034] Prior to the calibration, a calibration program is stored in the memory area 22, for example once for all. The 
program is adapted to control the movements of the robot and the other functions during the calibration process. Fur- 
ther, there are stored in the memory area 23 preliminary values for the calibration parameters, and in the memory area 
25 the radius r of the calibration tod. The structure of the calibration program is shown in Figure 5. The quantity j 

55 denotes the current measurement and it is assumed that M measurements are to be performed. After start of the pro- 
gram, ST, j = 1 is set. Thereafter, the radius r (STO r) of the calibration tool and coordinates for a starting-point (block 
STO Pj) are stored in the working storage of the equipment. This information indicates in which direction the calibration 
tool is to be moved from the starting-point to reach the calibration beam. Then, the robot is moved, block GTS, in a 




25 



is determined. 
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direction towards the calibration beam. In block CO? it is sensed whether the beam has been interrupted. If the answer 
is no, the movement is continued, and if the answer is yes, the resolver values <f>,j are stored in the memory area 24, 
block STO <£}j (i = axis number). After this, it is investigated in block j = M? whether all the desired measurements have 
been carried out. If this is not the case, j = j + 1 is set and the next measurement is carried out. When all the measure- 
5 ments have been carried out, that is, when j = M , the program proceeds to a calculation process, DET par, where the 
calibration parameters are determined. The parameters thus determined are then stored - STO par - to be subsequently 
used during operation of the robot. Thereafter, the program is ended - block SP. 

[0035] Figure 6 shows in more detail the structure of the functional block DET par. The calculation starts with a read- 
ing of current values of the calibration parameters, block RE par. The first time, these values are fetched from the mem- 

10 ory area 23, where the preliminary calibration parameters are stored. Thereafter, j = 1 is set, that is, the first 
measurement is chosen. The radius r of the calibration tool is stored in the working storage. The resolver values read 
and stored for this measurement are read. This is carried out in blocks RE r and RE <& iy Then the distance Cj between 
the centre of the calibration tool and the calibration beam for the current measurement is measured, based on the kin- 
ematic model of the robot. Thereafter, the difference ej = Cj - r is formed. Thereafter, j = M? , it is sensed whether all 

15 the measurements have been completed. If this is not the case, j = j + 1 is set and the corresponding calculation is car- 
ried out for the next measurement. When all the measurements have been completed, j = M and a quantity 



20 is formed. If this quantity amounts to or exceeds a predetermined tolerance value T, this is an indication that the values 
used for the calibration parameters are incorrect. In such case, these values are adjusted, for example according to the 
above-mentioned Newton-Gauss algorithm, in block ADJ par, whereupon the calculation is repeated. This process is 
repeated with successive adjustments of the calibration parameters and subsequent determinations of the error e until 
the last-mentioned quantity falls below the predetermined tolerance level. When this is the case, the program proceeds 

25 to the next block in Figure 6, where the last values used for the calibration parameters are stored. 

[0036] Figure 7 shows calibration parameters for a robot axis. The figure shows the nominal coordinate system X nom , 
Y norrv z nom °f an axis as we " as ' te actual coordinate system X ac{ , Y act , Z act . The latter deviates from the former by an 
offset error and an attitude error. 

[0037] As shown in Figure 7a, the position of the origin of coordinates in the actual coordinate system in relation to 
30 the origin of coordinates in the nominal coordinate system is described by a vector OE. This vector has three compo- 
nents and is expressed in the nominal coordinate system. 

[0038] As shown in Figure 7b, the actual coordinate system has an attitude error in relation to the nominal system. 
Three angles are required to rotate the actual system into correspondence with the nominal one, and these three 
angles denote the attitude error. 
35 [0039] The three components of the offset vector OE and the three angles of the attitude error constitute the six cal- 
ibration parameters of the current robot axis. 

[0040] In a preferred embodiments, the calibration beam is placed parallel to any of the xy, yz or xz plane in the base 
coordinate system of the robot. The calibration beam may also be placed completely arbitrarily within the working range 
of the robot, but then two more parameters are added which need to be identified, namely k* and k y which define the 
40 direction of the beam. 

[0041] In the above embodiment, a laser beam has been used as calibration beam, but other types of beams may be 
used, such as an IR beam. 

[0042] In the above embodiment, calculating means associated with the control system of the robot have been used 
for calculating the calibration parameters. It is, of course, also possible to use other calculating means outside the robot. 

45 [0043] In the foregoing, the invention has been described with reference to an industrial robot with rotating axes only, 
but the invention may be applied with the same advantage to robots with linear axes only, or with a combination of linear 
and rotating axes. Likewise, the method according to the invention is applicable to robots with a number of axes different 
from that described above. Further, it has been described above how the method is used for calibration of all of the axes 
of the robot. It may sometimes be suitable to refrain from calibrating one or more of the robot axes. To achieve the great- 

50 est possible variation between the robot configurations used, the robot may be provided with several calibration beams 
arranged at different locations within the working range of the robot, which locations are chosen such that the greatest 
possible differences are obtained between the robot configurations during the different measurements. 
[0044] It has been described above how six calibration parameters are determined for each robot axis. The number 
may be greater, for example if it is desired to take into account also nonlinearities of the position transducers of the axis 

55 during the calibration. The number may also be smaller, for example if it is known from experience that one or a few 
calibration parameters are known or of a negligible magnitude. 
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Claims 

1 . A method for calibration of an industrial robot (2-6) which has a plurality of movement axes (A1-A6) with an position 
transducer for each of said axes adapted to supply an output signal which defines the current position of the axis, 

5 a robot hand (6) for supporting a tool, and a control system (8) for control of the position and orientation of the robot 

hand in accordance with a program, wherein a number of calibration parameters for the robot are determined by 

a) providing the robot with a calibration tool (7), supported by the robot hand, comprising a sphere (7a) with a 
known radius (r), 

10 

b) providing a member (1 1) adapted to transmit a calibration beam within the working range (12) of the robot, 
and a member (13) connected to the control system which detects an interruption in the calibration beam, 

c) running the calibration tool towards the calibration beam, 

15 

d) reading and storing the output signals from the position transducers of the robot when an interruption in the 
calibration beam is detected, 

e) repeating steps c and d a number of times at least equal to the number of calibration parameters plus two 
20 and with different configurations of the robot, 

f) calculating the calibration parameters based on 

1) the kinematic equations of the robot, 
25 2) a model of the relationship between axial position and position transducer signal, 

3) the read and stored position transducer signals, and 

4) the known radius. 

2. A method according to claim 1, characterized in that the calibration beam is arranged parallel to a plane (XY, XZ, 
30 YZ) in the robot base coordinate system. 

3. A calibration device for carrying out the method according to claim 1 for an industrial robot (2-6) which has 

a plurality of movement axes (A1 -A6) with a position transducer for each of said axes adapted to supply an out- 
35 put signal which defines the current position of the axis, 

a robot hand (6) for supporting a tool, 

a control system for control of the position and orientation of the robot hand in accordance with a program and 
adapted to receive the output signals of the position transducers, wherein the calibration device comprises 
a calibration tool (7) provided with a sphere (7a) with a known radius (r) and adapted to be supported by the 
40 robot hand, 

calculating means (26) adapted to calculate a number of calibration parameters based on 

1) the kinematic equations of the robot, 

2) a model of the relationship between axial position and position transducer signal, 
45 3) the read and stored position transducer signals, and 

4) the known radius, characterized in that it further comprises 

- a member (1 1) which transmits a calibration beam (12) within the working range of the robot, 

- a member (13) which detects an interruption in the calibration beam for connection to the control system 
and for initiation of reading and storage of the output signals from the position transducers of the robot. 

50 

4. A calibration device according to claim 3, characterized in that the calibration beam consists of a light beam. 
Patentanspruche 

55 1 . Kalibrierverfahren fur einen Industrieroboter (2-6) mit einer Mehrzahl Bewegungsachsen (A1-A6) mit einem Positi- 
onswandler fur jede dieser Bewegungsachsen, vorgesehen ein Ausgabesignal abzusenden, das die augenblickli- 
che Position der Achsen bestimmt und ein Steuersystem (8) zum Steuern der Position und der Ausrichtung der 
Roboterhand gemai3 einem Programm, in dem eine Reihe voll Kalibrierparametern fur den Roboter bestimmt wer- 
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den, indem 

a) der Roboter mit einem voll der Roboterhand getragenen Kalibrierwerkzeug (7), das eine Kugel (7a) mit 
bekanntem Radius (r) umfaBt, versehen wird, 

b) ein Teil (11) angeordnet wird, der vorgesehen ist, einen Kalibrierstrahl innerhalb des Wirkungsbereiches 
(12) des Roboters zu uberfuhren und ein Teil (13), das mit dem Steuersystem verbunden ist, der eine Unter- 
brechung im Kalibrierstrahl abliest, 

c) das Kalibrierwerkzeug gegen den Kalibrierstrahl gefuhrt wird, 

d) die Ausgabesignale vom Positionswandler des Roboters abgelesen und gespeichert werden, wenn eine 
Unterbrechung im Kalibrierstrahl abgelesen wird, 

e) die Schritte c und d sovielmal wiederholt werden, die mindestens gleich der Anzahl der Kalibrierparameter 
plus zwei sind und mit verschiedenen Robotereinstellungen, 

f) die Kalibrierparameter berechnet werden, ausgehend von 

1) der kinemattschen Gleichung des Roboters, 

2) einem Modell der Beziehung zwischen der achsialen Position und dem Positionswandlersignal, 

3) die abgelesenen und gespeicherten Positionswandlersignale, und 

4) dem bekannten Radius. 

2. Verfahren gemaB Patentanspruch 1 , dadurch gekennzeichnet, daB der Kalibrierstrahl parallel zu einer Ebene 
(XY, XZ, YZ) im Grundkoordinatensystem des Roboters angeordnet ist. 

3. Kalibriervorrichtung zum Durchfuhren des Verfahrens gemSB Patentanspruch 1 fur einen Industrieroboter (2-6) mit 

einer Mehrzahl von Bewegungsachsen (A1-A6) miit einem Positionswandler fur jede dieser Achsen, vorgese- 
hen ein Ausgabesignal abzusenden, das die augenblickliche Position der Achsen bestimmt, 
eine Roboterhand (6) zum Halten eines Werkzeuges, 

ein Steuersystem zum Steuern der Position und der Ausrichtung der Roboterhand gemSB einem Programm 
und vorgesehen die Ausgabesignale des Positionswandlers zu empfangen, wobei die Kalibriervorrichtung 
umfaBt 

ein mit einer Kugel (7a) mit bekanntem Radius (r) versehenes Kalibrierwerkzeug (7) und vorgesehen von der 
Roboterhand gehalten zu werden, 

Berechnungselemerrte (26) vorgesehen eine Anzahl von Kalibrierparametern zu berechnen, die sich aufbauen 
auf 

1) der kinematischen Gleichung des Roboters, 

2) einem Modell der Beziehung zwischen der achsialen Position und dem Positionswandlersignal, 

3) den abgelesenen und gespeicherten Positionswandlersignale, und 

4) dem bekannten Radius. 

dadurch gekennzeichnet, daB sie auBerdem umfaBt 

einen Teil (1 1), der einen Kalibrierstrahl (12) innerhalb des Wirkungsbereiches des Roboters uberfuhrt, 
einen Teil (13) der eine Unterbrechung im Kalibrierstrahl abliest zum AnschluB an das Steuersystem und urn 
das Ablesen und Speichern der Ausgabesignale von den Positionswandlern des Roboters auszulOsen. 

4. Kalibriervorrichtung gemSB Patentanspruch 3, dadurch gekennzeichnet, daB der Kalibrierstrahl aus einem Licht- 
strahl besteht. 

Revendications 

1. Proc6d6 pour 6talonner un robot (2 k 6) industriel qui comporte une plurality d'axes (A1 k AS) de d^placement 
ayant, pour chacun des axes un transducteur de position congu pour donner un signal de sortie qui d§f init la posi- 
tion en cours de I'axe, une main (6) de robot destin6e k sup-, porter un outil, un syst&me (8) de commande destine 
k commander la position et I'orientation de la main de robot conform6ment k un programme, dans lequel un certain 
nombre de param£tres d'6talonnage pour le robot sont d6termin6s par 

a) le fait de munir le robot d'un outil (7) d'etalonnage, supports par la main de robot, comportant une sphere 
(7a) ayant un rayon (r) connu, 
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b) le fait de pr6voir un 6l6ment (11) congu pour Gmettre un faisceau d'6talonnage dans la portee (12) du robot, 
et un 6l6ment (13) qui est reliG au systeme de commande et qui d6tecte une interruption du faisceau d'&alon- 
nage. 

c) le fait de d^placer I'outil d'6talonnage en direction du faisceau d'6talonnage, 

d) le fait de lire et m6moriser les signaux de sortie des transducteurs de position du robot lorsqu'une interrup- 
tion du faisceau d'&alonnage est d6tect6e, 

e) le fait de r6peter l'6tape c et l'6tape d un certain nombre de fois au moins 6gal au nombre de param&re 
d'6talonnage plus deux et avec differentes configurations du robot, 

f) le fait de calculer les param&res d'6talonnage sur la base 

1) des Equations cin6matiques du robot. 

2) d'un module de la relation entre le signal de position axiale et le signal de transducteur de position, 

3) des signaux de transducteur et de position lus et m6moris£s, et 

4) du rayon connu. 

Proc6d£ suivant la revendication 1 , caract6ris6 en ce que le faisceau d'6talonnage est dispose parall&lement k un 
plan (XY, XZ, YZ) dans le systeme de coordonnSes de base du robot 

Dispositif d'Stalonnage pour mettre en oeuvre le procedG conforme k la revendication 1 pour un robot (2 k 6) indus- 
triel qui comporte 

une plurality d'axes (A1 & A6) de d6placement, comportant, pour chacun des axes, un transducteur de position 
con$u pour fournir un signal de sortie qui d§finit la position courante de I'axe 
une main (6) de robot destinGe k supporter un outil, 

un systeme de commande destine k commander la position et' I'orientation de la main de robot conform6ment 
k un programme et congu pour recevoir les signaux de sortie du transducteur de position, dans lequel le dis- 
positif d'6talonnage comprend 

un outil (7) d'6talonnage muni d'une sphere (7a) ayant un rayon (r) connu et congu pour §tre supports par la 
main de robot ; 

des moyens (26) de calcul congus pour calculer un certain nombre de param^tres d'6talonnage sur la base 

1) des Equations cin6matiques du robot, 

2) d'un module de la relation entre la position axiale et le signal du transducteur de position, 

3) des signaux de transducteur de position m6moris6s et lus, et 

4) du rayon connu, caract6ris6 en ce qu'il comporte en outre 

un 6l6ment (11) qui transmet un faisceau (12) d'6talonnage dans la portee du robot, 

un 6l6ment (13) qui d6tecte une interruption du faisceau d'6talonnage pour la liaison au syst&me de com- 
mande et pour {'initiation de la lecture et de la memorisation des signaux de sortie des transducteurs de posi- 
tion du robot. 

Dispositif d'Gtalonnage suivant la revendication 3. caract6ris6 en ce que le faisceau d'6talonnage est constituS d'un 
faisceau lumineux. 
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Fig. 3a 
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Fig. 3b 
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